Introduction To Optimization And Optimal Control Using The Software Packages Casadi And Acado